#include "Modbus_Master.h"
#include "string.h"
#include "bsp_RingBuffer.h"

modbus_BYTE_t Sendbuf[64]; // 用来组包
modbus_BYTE_t Rx_buf[64];  // 用来接收数据帧

MB_read_reg_RX_Typedef *MB_read_reg_buf;
MB_ERR_Typedef *MB_err_code;
extern RingBuffer_Typedef MB_RxBuf;
static const modbus_BYTE_t aucCRCHi[] =
	{
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
		0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
		0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
		0x00, 0xC1, 0x81, 0x40};

static const modbus_BYTE_t aucCRCLo[] =
	{
		0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06, 0x07, 0xC7,
		0x05, 0xC5, 0xC4, 0x04, 0xCC, 0x0C, 0x0D, 0xCD, 0x0F, 0xCF, 0xCE, 0x0E,
		0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09, 0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9,
		0x1B, 0xDB, 0xDA, 0x1A, 0x1E, 0xDE, 0xDF, 0x1F, 0xDD, 0x1D, 0x1C, 0xDC,
		0x14, 0xD4, 0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13, 0xD3,
		0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3, 0xF2, 0x32,
		0x36, 0xF6, 0xF7, 0x37, 0xF5, 0x35, 0x34, 0xF4, 0x3C, 0xFC, 0xFD, 0x3D,
		0xFF, 0x3F, 0x3E, 0xFE, 0xFA, 0x3A, 0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38,
		0x28, 0xE8, 0xE9, 0x29, 0xEB, 0x2B, 0x2A, 0xEA, 0xEE, 0x2E, 0x2F, 0xEF,
		0x2D, 0xED, 0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6, 0x26,
		0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60, 0x61, 0xA1,
		0x63, 0xA3, 0xA2, 0x62, 0x66, 0xA6, 0xA7, 0x67, 0xA5, 0x65, 0x64, 0xA4,
		0x6C, 0xAC, 0xAD, 0x6D, 0xAF, 0x6F, 0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB,
		0x69, 0xA9, 0xA8, 0x68, 0x78, 0xB8, 0xB9, 0x79, 0xBB, 0x7B, 0x7A, 0xBA,
		0xBE, 0x7E, 0x7F, 0xBF, 0x7D, 0xBD, 0xBC, 0x7C, 0xB4, 0x74, 0x75, 0xB5,
		0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71, 0x70, 0xB0,
		0x50, 0x90, 0x91, 0x51, 0x93, 0x53, 0x52, 0x92, 0x96, 0x56, 0x57, 0x97,
		0x55, 0x95, 0x94, 0x54, 0x9C, 0x5C, 0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E,
		0x5A, 0x9A, 0x9B, 0x5B, 0x99, 0x59, 0x58, 0x98, 0x88, 0x48, 0x49, 0x89,
		0x4B, 0x8B, 0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C, 0x8C,
		0x44, 0x84, 0x85, 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42, 0x43, 0x83,
		0x41, 0x81, 0x80, 0x40};

modbus_t usMBCRC16(modbus_BYTE_t *pucFrame, modbus_t usLen)
{
	modbus_BYTE_t ucCRCHi = 0xFF;
	modbus_BYTE_t ucCRCLo = 0xFF;
	int iIndex;

	while (usLen--)
	{
		iIndex = ucCRCLo ^ *(pucFrame++);
		ucCRCLo = (modbus_BYTE_t)(ucCRCHi ^ aucCRCHi[iIndex]);
		ucCRCHi = aucCRCLo[iIndex];
	}
	return (modbus_t)(ucCRCHi | ucCRCLo << 8);
	// return (modbus_t)(ucCRCLo << 8 | ucCRCHi);
}

/** @brief  读单路寄存器 0x03
 *  @param  Slave_Id (从机ID)
 *  @param  start_reg_addr (要读取的寄存器地址)
 *  @param  datalen (要读取的寄存器数量)
 *  @param  data (读出的数据)
 *  @return 读出的数据
 *  @property 无
 */
MB_ERROR_TYPEDEF mb_read_reg(modbus_BYTE_t Slave_Id, modbus_t start_reg_addr, modbus_t datalen, modbus_t *data)
{
	modbus_BYTE_t Delay_Time;
	modbus_t crc16;
	uint16_t Cnt, Datalen = 0;
	Sendbuf[0] = Slave_Id;
	Sendbuf[1] = 0x03;
	Sendbuf[2] = start_reg_addr >> 8;
	Sendbuf[3] = start_reg_addr & 0xff;
	Sendbuf[4] = datalen >> 8;
	Sendbuf[5] = datalen & 0xff;
	crc16 = usMBCRC16(Sendbuf, 6);
	Sendbuf[6] = crc16 >> 8;
	Sendbuf[7] = crc16 & 0xff;
	while (RB_ReadBytes(&MB_RxBuf, Rx_buf + Datalen, 255 - Datalen))
		;
#ifndef MB_DMA
	// modbus_BYTE_t i;

	MB_putchar(Sendbuf, 8);

#else

	MB_Dma_Send(Sendbuf, 8);
#endif
	Datalen = 0;
	// memset(Rx_buf, 0, 256);
	Delay_Time = 10;
	while (1)
	{
		Cnt = RB_ReadBytes(&MB_RxBuf, Rx_buf + Datalen, 255 - Datalen);
		if (Cnt)
		{
			Datalen += Cnt;
			if (Datalen >= 255)
			{
				break;
			}
			MB_delay(5);
		}
		else
		{
			if (Delay_Time && Datalen == 0)
			{
				Delay_Time--;
				MB_delay(5);
			}
			else
			{
				break;
			}
		}
	}
	if (Datalen >= 5 && usMBCRC16(Rx_buf, Datalen - 2) == (Rx_buf[Datalen - 2] << 8 | Rx_buf[Datalen - 1]))
	{
		if (Rx_buf[0] == Slave_Id)
		{
			if (Rx_buf[1] & 0x80)
			{
				MB_err_code = (void *)Rx_buf;
				return (MB_ERROR_TYPEDEF)MB_err_code->mb_err_code;
			}
			else
			{
				MB_read_reg_buf = (void *)Rx_buf;
				if (MB_read_reg_buf->mb_base.mb_function == 0x03)
				{
					if (MB_read_reg_buf->mb_datalen / 2 == datalen)
					{
						for (uint8_t i = 0; i < datalen; i++)
						{
							data[i] = REG16SWAP(MB_read_reg_buf->mb_data[i]);
						}
						return MB_OK;
					}
				}
				else
				{
					return MB_BUSY_ERROR;
				}
			}
		}
	}
	return MB_UNIT_ERROR;
}
/** @brief  写单路寄存器 0x06
 *  @param  Slave_Id (从机ID)
 *  @param  start_reg_addr (要读取的寄存器地址)
 *  @param  data (写入的数据)
 *  @return 成功或失败
 *  @property 无
 */
MB_ERROR_TYPEDEF mb_write_single_reg(modbus_BYTE_t Slave_Id, modbus_t start_reg_addr, modbus_t data)
{
	modbus_BYTE_t Delay_Time;
	modbus_t crc16;
	uint16_t Cnt, Datalen = 0;
	Sendbuf[0] = Slave_Id;
	Sendbuf[1] = 0x06;
	Sendbuf[2] = start_reg_addr >> 8;
	Sendbuf[3] = start_reg_addr & 0xff;
	Sendbuf[4] = data >> 8;
	Sendbuf[5] = data & 0xff;
	crc16 = usMBCRC16(Sendbuf, 6);
	Sendbuf[6] = crc16 >> 8;
	Sendbuf[7] = crc16 & 0xff;
	while (RB_ReadBytes(&MB_RxBuf, Rx_buf + Datalen, 255 - Datalen))
		;
#ifndef MB_DMA
	// modbus_BYTE_t i;

	MB_putchar(Sendbuf, 8); // 发送数据

#else

	MB_Dma_Send(Sendbuf, 8);

#endif

	Datalen = 0;
	// memset(Rx_buf, 0, 5);
	Delay_Time = 10;
	while (1) // 接收数据
	{
		Cnt = RB_ReadBytes(&MB_RxBuf, Rx_buf + Datalen, 255 - Datalen);
		if (Cnt)
		{
			Datalen += Cnt;
			if (Datalen >= 255)
			{
				break;
			}
			MB_delay(5);
		}
		else
		{

			if (Delay_Time && Datalen == 0)
			{
				Delay_Time--;
				MB_delay(5);
			}
			else
			{
				break;
			}
		}
	}
	//
	if (Datalen >= 5 && usMBCRC16(Rx_buf, Datalen - 2) == (Rx_buf[Datalen - 2] << 8 | Rx_buf[Datalen - 1]))
	{
		if (Rx_buf[0] == Slave_Id)
		{
			if (Rx_buf[1] & 0x80)
			{
				MB_err_code = (void *)Rx_buf;
				return (MB_ERROR_TYPEDEF)MB_err_code->mb_err_code;
			}
			else
			{
				if (memcmp(Rx_buf, Sendbuf, 8) == 0)
				{
					return MB_OK;
				}
				else
				{
					return MB_BUSY_ERROR;
				}
			}
		}
	}
	return MB_UNIT_ERROR;
}
/** @brief  写多路寄存器 0x10
 *  @param  Slave_Id (从机ID)
 *  @param  start_reg_addr (要读取的寄存器地址)
 *  @param  data (写入的数据)
 *  @return 成功或失败
 *  @property 无
 */
MB_ERROR_TYPEDEF mb_write_multi_reg(modbus_BYTE_t Slave_Id, modbus_t start_reg_addr, modbus_t datalen, modbus_t *data)
{
	modbus_BYTE_t Delay_Time;
	modbus_t crc16;
	uint16_t Cnt, Datalen = 0;
	Sendbuf[0] = Slave_Id;
	Sendbuf[1] = 0x10;
	Sendbuf[2] = start_reg_addr >> 8;
	Sendbuf[3] = start_reg_addr & 0xff;
	Sendbuf[4] = datalen >> 8;
	Sendbuf[5] = datalen & 0xff;
	Sendbuf[6] = datalen * 2;
	for (uint8_t i = 0; i < datalen; i++)
	{
		Sendbuf[7 + i * 2] = data[i] >> 8;
		Sendbuf[7 + i * 2 + 1] = data[i] & 0xff;
	}
	crc16 = usMBCRC16(Sendbuf, 7 + datalen * 2);
	Sendbuf[7 + datalen * 2] = crc16 >> 8;
	Sendbuf[7 + datalen * 2 + 1] = crc16 & 0xff;
	while (RB_ReadBytes(&MB_RxBuf, Rx_buf + Datalen, 255 - Datalen))
		;

#ifndef MB_DMA
	MB_putchar(Sendbuf, 7 + datalen * 2 + 2);
#else
	MB_Dma_Send(Sendbuf, 7 + datalen * 2 + 2);

#endif
	Datalen = 0;
	// memset(Rx_buf, 0, 256);
	Delay_Time = 10;
	while (1)
	{
		Cnt = RB_ReadBytes(&MB_RxBuf, Rx_buf + Datalen, 255 - Datalen);
		if (Cnt)
		{
			Datalen += Cnt;
			if (Datalen >= 255)
			{
				break;
			}
			MB_delay(5);
		}
		else
		{

			if (Delay_Time && Datalen == 0)
			{
				Delay_Time--;
				MB_delay(5);
			}
			else
			{
				break;
			}
		}
	}
	if (Datalen >= 5 && usMBCRC16(Rx_buf, Datalen - 2) == (Rx_buf[Datalen - 2] << 8 | Rx_buf[Datalen - 1]))
	{
		if (Rx_buf[0] == Slave_Id)
		{
			if (Rx_buf[1] & 0x80)
			{
				MB_err_code = (void *)Rx_buf;
				return (MB_ERROR_TYPEDEF)MB_err_code->mb_err_code;
			}
			else
			{
				MB_read_reg_buf = (void *)Rx_buf;
				if (MB_read_reg_buf->mb_base.mb_function == 0x10)
				{
					// memcpy(data, MB_read_reg_buf->mb_data, (MB_read_reg_buf->mb_datalen < datalen * 2 ? MB_read_reg_buf->mb_datalen : datalen * 2));
					return MB_OK;
				}
				else
				{
					return MB_BUSY_ERROR;
				}
			}
		}
	}
	return MB_UNIT_ERROR;
}
